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FIG.4C 



RESIDUAL FORM METHOD 
TO COMPUTE p q AND p u 


DIRECT FORM METHOD 
TO COMPUTE q AND u 


1 . COMPUTE THE FIRST KINEMATICS 
CALC. AND THE FIRST KINEMATIC 
RESIDUAL p q (k) 

2. GENERATE T(k), THE SPATIAL LOAD 
BALANCE FOR EACH BODY 

3. COMPUTE DYNAMIC RESIDUAL p u (k) 


1. COMPUTE q USING JOINT 
SPECIFIC ROUTINES 

2. PERFORM FIRST KINEMATICS CALC. 
WITH u = 0 

3. GENERATE RESIDUALS p u 
AND NEGATE p u = -p u 

4. PERFORM SECOND KINEMATICS CALC. 

5. COMPUTE u USING FORWARD 
DYNAMICS 



COMPARISON OF METHODS 
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